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21 . 10 . 99 We/Ep 

ROBERT BOSCH GMBH , 70442 Stuttgart 

Abstancissensor mit einer K ompensationseinrichtung fur einen 
Deiust aaewinkel an einem Fahrzeug 

Stand der Technik 

Die Erfindung geht aus von einem Abstandssenor fur ein 
Fahrzeug mit einem Sensor zum Senden von Mikrowellen oder 
Licht bzw. zum Empfangen eines von einem Zielobjekt 
ref lektierten Echosignals nach der Gattung des 
Hauptanspruchs . Bei Geschwindigkeitsreglern mit einem 
Abstandssensor (Adaptive Cruise Control, ACC) ist schon 
bekannt, die Fahrgeschwindigkeit eines Kraf tf ahrzeugs an 
langsamere, vorausf ahrende Fahrzeuge anzupassen, wenn diese 
von dem Abstandssensor erfa£t werden. Der Abstandssenor bat 
jedoch einen begrenzten Erf assungsbereich und kann somit nur 
solche Fahrzeuge erfassen, die sich im voraussicht lichen 
Kursbereich des nachf olgenden Fahrzeugs befinden. Eine 
Dejustage dieses Erf assungsbereichs , die entweder bei der 
Montage an dem Fahrzeug oder wahrend des Betriebs auftreten 
kann, bewirkt jedoch, da£ die Langsachse des Abstandssensors 
relativ zur Sollausrichtung (Mittelachse des Fahrzeugs) 
einen systematischen Fehlerwinkel aufweist . Die Folge 
hieraus kann sein, daS dieser De justagewinkel beispielsweise 
zu einer falschen Spurzuordnung eines erfaSten Radarob j e3ctes 
auf der Bewegungsbahn des Kraf t fahrzeugs (Traj ektorie) , d.h. 
eines verfolgten oder entgegenkommenden Fahrzeugs fuhrt und 
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es dadurch zu einer ungewollten Reaktion des Geschwindig- 
keitsreglers kommen kann. 

Bekannt ist beispielsweise aus der DE 197 46 524 Al eine 
Kompensationseinrichtung zur Kompensation der 
Einbautoleranzen eines Abstandssensors an einem Fahrzeug, 
bei der Einbautoleranzen des Abstandssensors kompensiert 
werden. Mittels einer Auswerteelektronik werden wahrend des 
Fahrbetriebs aktuelle Objektabstande und ein aktueller 
Objektwinkel fur erfaSte Objekte relativ zur Fahrzeugachse 
gemessen. Dabei wird der De justagewinkel durch 
Mittelwertbildung uber viele Messungen zum aktuellen Ziel- 
objekt bestimmt . Allerdings funktioniert diese Mittelwert- 
bildung nur dann zuf riedenstellend, wenn das Fahrzeug das 
Zielobjekt, ein vorausf ahrendes , zweites Fahrzeug, auf einer 
ausreichend langen geraden Strecke verfolgen kann, so da£ 
haufige Messungen zum Zielobjekt durchfuhrbar sind. Bei 
StraSenkrummungen oder auch Berg- und Talfahrten mit sich 
anderndem Hohenwinkel versagt diese Methode . 

Bei der Vorrichtung zur Berechnung und Korrektur eines 
Dejustagewinkels fur einen Abstandssensor gemaS der 
EP 0 782 008 A2 wird dagegen der Winkel fur die Abweichung 
von der Mittelachse mittels eines Regressionsverf ahrens 
beschrieben. Dabei werden in jedem MeSzyklus Winkel in 
Abhangigkeit vom Abstand von bewegten oder besser noch von 
stehenden Radarob j ekten gemessen. Insbesondere bei sehr 
dichtem Verkehr sind jedoch nicht genugend geeignete Objekte 
im Sichtbereich des Sensors vorhanden, so da£ nicht genugend 
Me£werte vorliegen. So hat jedes Verfahren den Nachteil, daS 
die Verfiigbarkeit von MeEwerten von der Fahrsituation bzw. 
von der Verkehrssituation abhangt . 



Vorteile der Erfindung 
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Der erfindungsgemaSe Abstandssensor bzw. der Geschwindig- 
keitsregler gemaS den nebengeordneten Anspriichen 1 und 11 
hat demgegenuber den Vorteil, da£ sich durch die Kombination 
von mehreren Methoden zur Bestimmung eines Dejustagewinkels 
die Zuverlassigkeit der De justageerkennung erhoht . 

Ein besonderer Vorteil gegeniiber dem bekannten Stand der 
Technik wird auch darin gesehen, da£ die Messungen fur den 
Dejustagewinkel nicht nur auf einer geraden Fahrstrecke, 
sondern auch in einer Kurve durchfiihrbar sind. Hierdurch 
ergeben sich mehr Mefcwerte, die insbesondere auch die 
Mittelwertbildung begiinstigen. 

Durch die in den abhangigen Anspriichen auf gef iihrten Ma£- 
nahmen sind vorteilhafte Weiterbildungen und Verbesserungen 
des im Hauptanspruch angegebenen Abstandssensors moglich. 
Besonders vorteilhaft ist, da£ als weiteres Mittel ein Gier- 
ratensensor vorgesehen ist, dessen Signale zur Korrektur der 
Trajektorienkriimmungen verwendbar sind. Da der Gierraten- 
sensor die Drehbewegung des Fahrzeugs um die Hochachse 
erfaSt, erkennt er somit unter Beriicksicht igung der Fahr- 
geschwindigkeit auch die Krummung der Fahrbahn oder Kurve, 
so da£ aus diesen Daten entsprechende Winkelberechnungen zu 
einem vorausf ahrenden Fahrzeug, das vom Sensor erfafit wurde, 
durchgefiihrt werden konnen. Als Kriimmung einer Trajektorie 
wird dabei der Kehrwert des Radius der Bahn (in englisch: 
curvature ) angesehen . 

Mit Hilfe einer adaptiven Langzeitf ilterung werden aus den 
ermittelten De justagewinkeln von Einzel tra j ektorien 
Qualitatsindikatoren der Trajektorie ermittelt. Mit Hilfe 
der Qualitatsindikatoren der Trajektorie wird die Zuver- 
lassigkeit der Winkelmessung vorteilhaft verbessert . Dabei 
erfolgt die Bestimmung des Qualitatsindikators beispiels- 
weise aus dem Korrelat ionswert einer Regressionsanalyse , aus 



- 4 - 



R. 36631 

der Krummung, cier Anzahl der MeSpunkte, der Trajektorien- 
lange und/oder der Objektgeschwindigkeit . Da diese Parameter 
relativ einfach zu erfassen sind, ist damit auch eine 
einfache Berechnung des Qualitatsindikators moglich. 

Fur die Anwendung der adaptiven Langzeit f ilterung der er- 
mittelten Dejustagewinkel aus Einzeltrajektorien eignet sich 
beispielsweise ein rauschoptimales, lineares, adaptives 
Filter (z.B. Kalman-Fil ter ) oder ein nichtlineares Filter, 
bei dem die Gewichtung des EinzelmeSwerts aus der 
Giitebewertung, basierend auf Qualitat sindikatoren der 
Trajektorie, beruht . 

Als ein geeignetes adaptives Langzeitf ilter ist auch ein 
nichtlineares Filter verwendbar, bei dem die Gewichtung der 
EinzelmeSwerte aus der Giitebewertung erf olgt . 

Als besonderer Vorteil wird angesehen, da£ bei einer 
Anordnung des Sensors auSerhalb der Mittelachse des 
Kraf tfahrzeugs die Steuerung den Justagewinkel in Bezug auf 
die Mittelachse des Fahrzeugs ermittelt. Dadurch wird auch 
der seitliche Winkel kompensiert , der durch die Mittenver- 
schiebung des Sensors entsteht. 

Guns tig ist auch, da£ die Ermittlung des De justagewinkels 
entweder in Abhangigkeit von den gewichteten Mittelwerten 
des Gierratensensors oder denen aus dem Versatz von der 
Mittelachse gewichtet wird. Dadurch erhalt man eine Ver- 
besserung der Signalquali tat , die je nach Verf ugbarkeit der 
einzelnen Systeme die Robustheit des Verfahrens zur Be- 
st immung des De j ustagewinkels verbessert, da nahezu immer 
mindestens eines der beiden Verfahren geeignete Eingangs- 
daten erhalt. Das eine Verfahren kompensiert dadurch vor- 
teilhaft die Schwachen des anderen Verfahrens. 
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Durch die Wichtung iiber die gemittelten Mittelwerte der 
beiden Einzelverf ahren erhalt man eine verbesserte 
Signalqualitat . 

Zeichnung 

Ein Ausfuhrungsbeispiel der Erf indung ist in der Zeichnung 
dargestellt und in der nachf olgenden Beschreibung naher 
erlautert . 

Figur 1 zeigt ein l. Diagramm mit Winkeldarstellungen von 
Strahlengangen, Figur 2 zeigt ein Blockschaltbild eines 
Abstandssensors und Figur 3 zeigt ein 2. Diagramm. 



Beschreibung des Ausf iihrungsbeispiels 

Figur 1 zeigt zwei Kraf t f ahrzeuge 5, 6, die auf einer StraSe 
mit einem Abstand d hintereinander herfahren, wobei davon 
ausgegangen wird, dafi sich das Kraf t f ahrzeug 5 hinter dem 
Kraf tfahrzeug 6 bef indet . Des weiteren sind aus Griinden der 
Ubersichtlichkeit nur die Mittenstrahlen eines Sensors 2 
dargestellt, nicht die gesamte Strahlung im 

Abstrahlungsbereich. Dabei wird in dem Ausfuhrungsbeispiel 
angenommen, daS an der Frontseite in einer ersten Aus- 
fuhrungsvarianten ein Sensor 2 mittig an der Frontseite des 
Kraftfahrzeugs 5 angebracht ist. Er ist dabei so 
ausgerichtet, da£ sein Mittelstrahl das Heck des voraus- 
fahrenden Kraftfahrzeugs 6 erf afit . Aufgrund einer ange- 
nommenen Dejustage trifft der Sendestrahl nicht entlang der 
Mittelachse des Kraftfahrzeugs 5 auf das Heck auf, sondern 
urn einen mittleren Winkel alpha_sensor verschoben. Voll- 
standigkeitshalber wird noch darauf hingewiesen, daS dieser 
reflektierte Strahl von einer entsprechenden Empfangs- 
einrichtung des Sensors 2 empfangen und ausgewertet wird. 
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Ein solches Auswerteverf ahren ist beispielsweise aus der 
DE 197 46 524 Al bekannt . GemaS dem erf indungsgemaSen 
Ausfuhrungsbeispiel wird der Sensor nun nicht mittig, 
sondern seitlich versetzt mit einem Abstand y rac i ar versetzt 
angeordnet . Bei diesem Sensor 2 trifft nun der Mitten- 
strahl b mit einem Winkel alpha_vehicle am Heck des Ziel- 
objekts 6 auf die verlangerte Mittelachse des Kraftfahr- 
zeugs 5 auf. Aus dieser von der Mitte versetzten Anordnung 
urn den Abstand y ra dar und dem Abstand d zum vorausf ahrenden 
Fahrzeug 6 kann nun ein Winkel bestimmt werden nach 
Gleichung 

alpha_vehicle « alpha_sensor + Yradar / d - 

Dieser Winkel alpha_vehicle wird durch wiederholte Messungen 
wahrend der Fahrt und einer geeigneten Langzeit f il terung er- 
mittelt. Mit diesem systematischen Fehler kann die Winkel- 
messung des Sensors 2 korrigiert werden. 

Dieses vornehralich auf einer geraden Strecke durchgef uhrte 
Verfahren mit der Kompensation des De justagewinkels iiber die 
Mittelung des aktuellen Zielob j ektwinkels iiber eine Vielzahl 
von Messungen ist weniger in Kurven anwendbar, da hier das 
Ziel „ vorausf ahrendes Fahrzeug 6" stets eine relative 
Fahrzeugposition in Bezug auf den Sensor 2 bedingt durch den 
Kurvenradius andert . Urn den Fehler, der durch den 
Kurvenradius der StraSe bedingt ist, zu kompensieren, ist am 
Kraf tf ahrzeug 5 ein Gierratensensor 3 vorgesehen, der die 
Richtungsanderung des Kraf t f ahrzeugs 5 urn seine Hochachse 
erf aSt . Mit Hilfe des normierten Signals aus dem Gierraten- 
sensor 3 und dem Winkel alpha_vehicle ergibt sich eine 
mittlere Abweichung fur den kurvenkorrigierten Winkel nach 
der Formel 
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d alpha_objekt = Mittelwert (alpha_vehicle - 
d 2 *Gierrate/ (2*Fahrgeschwindigkeit ) ) , 

wobei d a lpha__objekt dem korrigierten Winkel und die Gierrate 
dem Signal des Gierratensensors 3 entspricht. 

Es ist vorgesehen, die Mittelung iiber eine Langzeit-Tiefpa£- 
filterung durchzuf iihren . Je nach Haufigkeit der Mittelung 
kann des weiteren fur die GroSe d alpha _ ob j ekt ein 
Qualitatswert q Q bjekt f ^r dies Zuverlassigkeit des Winkels 
angegeben werden. Da eine Kurve 11 einer StraSe in eine 
Vielzahl von Trajektorien eingeteilt werden kann, ergibt 
sich fur die Bestimmung des De justagewinkels eine weitere 
Moglichkeit durch Anwendung eines per se bekannten 
Regressionsverfahrens, wie es beispielsweise in der 
EP 0 782 008 A2 beschrieben ist. Erf indungsgemaS werden 
entsprechend der Figur 3 in Abhangigkeit vom Abstand zu 
einem bewegten oder besser noch stehenden Zielobjekt 10, 
beispielsweise einem Leitplankenteil oder einem Pfosten, 
die Winkel wl bzw. w2 je nach der Position A bzw. B des 
Fahrzeuges 5 in der Kurve 11 gemessen. Aus dem Abstand d(ti) 
bzw. d(tj) zum Zeitpunkt ti (Position A) bzw. tj (Position 
B) des Fahrzeugs 5 z. B. zum Standziel 10 la£t sich nach 
einfacher trigonometrischer Umrechnung ein lateraler Versatz 
y(ti) bzw. y(tj) errechnen. Im Gegensatz zum bekannten 
Verfahren ergeben sich dadurch fur die Kurvenfahrt 
vorteilhaft zusatzliche MeSpunkte im Sichtbereich des 
Sensors 2. Erf indungsgemaS wird daher vorgeschlagen, dieses 
Verfahren der Regressionsanalyse von Trajektorien ebenfalls 
mit dem Gierratensignal des Gierratensensors 3 zu 
verkniipfen, urn die Tra j ektorienkrummungen zu kompensieren . 
Die so gewonnenen Mefiwerte werden durch eine adaptive 
Langzeitfilterung der ermittelten Dejustagewinkel aus 
Einzel trajektorien gemittelt. Als geeignete Filter kann ein 
rauschoptimales, lineares adaptives Filter, beispielsweise 
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ein Kalman-Filter verwendet werden. Alternativ ist auch ein 
nichtlineares Filter verwendbar, bei dem die Gewichtung des 
EinzelmeSwerts aus der Gutebewertung beruht , die auf 
Qualitatsindikatoren der Trajektorie basiert . Die 
Qualitatsindikatoren werden z.B. aus dem Korrelationswert 
der Regress ionsanalyse, aus der Krummung, Anzahl der 
MeSpunkte, Traj ektorienlange und Objektgeschwindigkeit 
gebildet . 

Als Ergebnis wird ein gleitender langzeitgef il terter 
Dejustagewinkel d alpha j- ra j bzw. ein Qualitatswert q_traj 
fur die Zuverlassigkeit des Winkels ermittelt bzw. mit jeder 
analysierten Trajektorie aktualisiert . 

Da auch dieses zweite Verfahren insbesondere irn dichten 
Kolonnenverkehr nicht immer geeignete Trajektorien liefert, 
werden in einer alternativen Losung vorteilhaft beide 
Ansatze miteinander verkniipf t . In Abhangigkeit von der 
Zuverlassigkeit der einzelnen Verfahren konnen die 
Gewichtungen der Ansatze statisch oder dynamisch variiert 
werden. Die Verkniipf ung beider Ansatze erfolgt iiber einen 
gewichteten Mittelwert beider Einzelverf ahren . Die Gewichte 
werden aus den Qualitatszahlen bestimmt: 

^alpha = Gl(q_traj)*d alpha _ traj + G2 ( q_ob j ) *d alpha _ ob j . 

Gl (q__traj) und G2 (q_obj) sind dabei die Gewichte aus den 
Qualitatszahlen. Q_traj und q__obj bilden dabei die 
Qualitatszahlen Qi . 

Durch die Einfiihrung von Qualitatszahlen Qi fur das 
jeweilige Verfahren mit einer Dekrementierung von Qi , falls 
fur das Verfahren im aktuellen Zyklus keine EingangsgroSen 
vorliegen, und einer Inkrementierung, falls EingangsgroSen 
vorliegen, wurde eine einfache Auswahlmoglichkei t gefunden, 
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welches der beiden Verfahren im Augenblick die zuver- 
lassigere Aussage uber die aktuelle Winkelmessung liefert. 
Neben der Verbesserung der Signalqualitat durch die Kombi- 
nation erhoht sich auch die Robustheit der Verfahren, da 
nahezu immer mindestens eins der beiden Verfahren geeignete 
Eingangsdaten erhalt, d.h. ein Verfahren kompensiert die 
Schwachen des anderen Verf ahrens . 

Figur 2 zeigt ein Blockschaltbild dfes Abstandssensors 10 , in 
dem die Steuerung 1 mit dem Sensor 2 und dem Gierratensensor 
3 verbunden ist. Des weiteren ist eine 

Kompensationsvorrichtung fur die Winkelmessung 4 vorgesehen, 
in der u.a. die Berechnung fur die Winkel u.a. durchgefiihrt 
wird. Die vorgenannten Berechnungen werden vorzugsweise mit 
einen Programm durchgefiihrt, das von dem Mikrocomputer der 
Steuerung 1 abgearbeitet wird. 
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21.10.99 We/Ep 

ROBERT BOSCH GMBH, 7 044 2 Stuttgart 
Anspriiche 

1. Abstands sensor fur ein Kraf tf ahrzeug, mit einem 
Sensor (2) zum Senden von Mikrowellen oder Licht bzw. 
Empfangen eines vom einem Zielobjekt ref lektierten 
Echosignals, und mit einer Steuerung (1) , die Mittel 
aufweist, wahrend einer Fahrt auf einer geraden StraSe aus 
den gesendeten und empfangenen Strahlen mittels eines 
Algorithmus einen De justagewinkel (alpha_sensor ) des Sensors 
(2) in Bezug auf die Mittelachse (M) des Kraf tf ahrzeugs (5) 
zu ermitteln und mit diesem die laufende Winkelmessung zu 
korrigieren, dadurch gekennzeichnet , da£ weitere Mittel (3) 
vorgesehen sind, mit denen bei einer Fahrt durch eine Kurve 
eine Kompensation von Trajektorienkrummungen durchfiihrbar 
ist . 

2. Abstandssensor nach Anspruch 1, dadurch gekenn- 
zeichnet, daS das weitere Mittel (3) ein Gierratensensor 
ist, dessen Signale zur Korrektur der Trajektorienkrummungen 
verwendbar sind. 

3. Abstandssensor nach Anspruch 1 oder 2, dadurch 
gekennzeichnet, da£ die Steuerung (1) ausgebildet ist, aus 
den ermittelten De justagewinkeln von Einzeltrajektorien 
durch adaptive Langzeit f ilterung einen Qualitats- 
indikator (q_traj) der Trajektorie zu bestimmen. 
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4. Ah stands sens or nach Anspruch 3, dadurch gekenn- 
zeichnet, dafi der Quali tatsindikator (q_traj) beispielsweise 
aus dem Korrelationswert einer Regressionsanalyse, aus der 
Krummung, der Anzahl der MeSpunkte, der Tra j ektorienlange 
und/oder der Obj ektgeschwindigkeit (6) gebildet ist. 

5. Abstandssensor nach Anspruch 3 oder 4, dadurch 
gekennzeichnet, dag das adaptive Langzeitf ilter ein 
rauschoptimales, lineares Filter, vorzugsweise ein Kalman- 
Filter ist. 

6. Abstandssensor nach Anspruch 3 oder 4, dadurch 
gekennzeichnet, date das adaptive Langzeitf ilter ein nicht 
lineares Filter ist, bei dem die Gewichtung des EinzelmeS- 
werts aus der Giitebewertung erf olgt . 

7 . Abstandssensor nach einem der vorherigen Anspruche , 

dadurch gekennzeichnet, daS bei einer Anordnung des Sensors 
(2) auSerhalb der Mittelachse (M) des Kraf tf ahrzeugs (5) die 
Steuerung (1) den De justagewinkel (alpha_sensor ) im Bezug 
auf die Mittelachse (M) ermittelt. 

8. Abstandssensor nach Anspruch 7, dadurch gekenn- 
zeichnet, da£ die Steuerung (1) ausgebildet ist, den 
Dejustagewinkel entweder in Abhangigkeit von den gewichteten 
Mittelwerten des Gierratensensors (3) oder dem Versatz 
(Yradar* von der Mittelachse (M) zu wichten. 

9. Abstandssensor nach Anspruch 8, dadurch gekenn- 
zeichnet, date die Wichtung uber die gewichteten Mittelwerte 
der beiden Einzelverf ahren erf olgt . 

10. Abstandssensor nach Anspruch 8 oder 9, dadurch 
gekennzeichnet, da£ aus den Gewichten (Gl, G2) 
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Qualitatszahlen fur cien De justagewinkel nach der Formel 
gebildet werden : 

d alpha = G1 (q_traj)*d alpha _ traj + G2 (q_ob j ) *d alpha _ ob j , 

wobei d alpha der momentan geltende De justagewinkel zur 
Mittelachse (M) ist und Gl (q_traj) bzw. G2 (q_obj) sind 
gewichtete Mittelwerte aus den Werten des Gierratensensors 
bzw. dem Mittenversatz, d alpha _ traj und d alpha _ obj sind 
zugehorige Winkel . 

11. Geschwindigkeitsregler mit einem Sensor nach einem 
der vorherigen Anspruche, dadurch gekennzeichnet, daS der 
Sensor (2) im Front- und/oder Heckbereich eines Kraft - 
fahrzeugs (5) angeordnet ist. 
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21.10.99 We/Ep 

ROBERT BOSCH GMBH, 70442 Stuttgart 

Abstandssensor mit einer Kompensationseinrichtuna fur einen 
Deiustaaewink el an einem Fahrzeug 

Zus ammenf as sung 

Erf indungsgema£ wird ein Abstandssensor mit einem Sensor fur 
ein Kraf tfahrzeug vorgeschlagen, bei dem Mittel vorgesehen 
sind, mit denen bei einer Fahrt nicht nur auf einer geraden 
StraSe, sondern auch in Kurven De justagewinkel und 
Trajektorienkrummungen kompensierbar sind. Bei einem aus der 
Mittelachse des Fahrzeugs versetzt angeordneten Sensor (2) 
wird ein Winkel (alpha_sensor ) gemessen, der die verlangerte 
Mittelachse des Kraf t fahrzeugs (5) am Zielobjekt, ein 
vorausfahrendes Fahrzeug (6), schneidet . Durch eine zusatz- 
liche Verwendung eines Gierratensensors (3) werden auch 
Kurvenkrummungen der StraSe kompensiert, so da£ die Winkel- 
und Abstandsmessung auch in Kurven erfolgen kann. 



(Figur 1) 



